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Abstract  -  Several  nonlinear  filtering  techniques  are 
investigated  for  nonlinear  tracking  problems . 
Experimental  results  show  that  for  a  weakly  nonlinear 
tracking  problem ,  the  extended  Kalman  filter  and  the 
unscented  Kalman  filter  are  good  choices ,  while  a 
particle  filter  should  be  used  for  problems  with  strong 
nonlinearity .  To  quantitatively  determine  the 
nonlinearity  of  a  nonlinear  tracking  problem ,  we 
propose  two  types  of  measures:  one  is  the  differential 
geometry  curvature  measure  and  the  other  is  based  on 
the  normalized  innovation  squared  (NIS)  of  the  Kalman 
filter.  Simulation  results  show  that  both  measures  can 
effectively  quantify  the  nonlinearity  of  the  problem.  The 
NIS  is  capable  of  detecting  the  filter  divergence  online. 

The  curvature  measure  is  more  suitable  for  quantifying 
the  nonlinearity  of  a  tracking  problem  as  determined  via 
simulations. 

Keywords:  Tracking,  extended  Kalman  filter,  unscented 
Kalman  filter,  particle  filter,  nonlinearity  measures. 

1  Introduction 

For  nonlinear  target  tracking  problems  with  nonlinear 
dynamics  or  nonlinear  measurements,  there  exist  many 
nonlinear  filtering  techniques.  A  comprehensive  tutorial  of 
these  nonlinear  techniques  is  given  in  [1].  In  this  paper, 
we  investigate  several  of  the  most  popular  nonlinear 
filtering  techniques,  including  the  extended  Kalman  filter 
(EKF)  [2],  the  unscented  Kalman  filter  (UKF)  [3]  and  the 
particle  filter  (PF)  [4-5].  Being  parametric  filtering 
methods  based  on  the  classical  Kalman  filter  framework, 
the  EKF  and  the  UKF  incur  only  a  modest  amount  of 
computational  cost  and  lead  to  near-optimal  performances 
in  problems  with  weak  nonlinearity.  However,  in  many 
highly  nonlinear  problems,  the  EKF  or  the  UKF  may 
diverge,  as  shown  later  in  this  paper.  The  PF,  a 
simulation-based  nonparametric  algorithm,  has  better 
performances  than  the  EKF  and  the  UKF  in  these  difficult 
highly  nonlinear  cases.  But  its  implementation  requires  a 
significantly  larger  amount  of  computation. 

Considering  the  advantages  and  disadvantages  of  these 
filters,  naturally  we  can  employ  different  filtering 
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algorithms  for  problems  with  different  degrees  of 
nonlinearity.  In  this  paper,  we  study  two  types  of 
nonlinearity  measures  to  quantitatively  determine  the 
nonlinearity  of  a  nonlinear  problem.  The  first  measure  is 
based  on  the  curvature  measure  [6],  which  compares  the 
magnitude  of  the  second-order  term  with  that  of  the  first- 
order  term  in  a  Taylor  series  expansion  of  the  nonlinear 
problem.  Recently,  the  curvature  measures  have  been 
adopted  in  indicating  the  nonlinearity  for  trajectory 
estimation  problems  [7-9].  Here,  we  use  them  to  determine 
the  nonlinearity  in  the  tracking  problem.  We  also  propose 
the  normalized  innovation  squared  (NIS)  [2]  of  the 
Kalman  filter,  as  a  measure  of  nonlinearity  and  of  filter 
divergence. 

In  Section  2,  a  brief  introduction  to  the  three  nonlinear 
tracking  algorithms  is  provided.  Tracking  examples  with 
strong  and  weak  nonlinearities  to  illustrate  the  necessity  of 
nonlinearity  measures  are  presented  in  Section  3.  The 
curvature  nonlinearity  measure  and  the  divergence 
detector  based  on  Kalman  filter’s  innovation  are  proposed 
in  Section  4.  There,  the  effectiveness  of  these  two 
measures  is  verified  by  simulation  results.  Conclusions  are 
drawn  in  Section  5. 

2  Nonlinear  filtering  techniques 

For  a  target  tracking  problem  with  nonlinear  target  motion 
model  and/or  nonlinear  measurements,  one  of  the  most 
popular  filtering  techniques  is  the  EKF,  which  is  a 
minimum  mean  square  error  (MMSE)  estimator  based  on 
the  Taylor  series  expansion  of  the  nonlinear  dynamics  or 
the  nonlinear  measurement  [2].  It  is  very  easy  to 
implement  and  requires  only  modest  amount  of 
computational  power. 

In  the  first-order  EKF  the  state  distribution  is 
approximated  by  a  Gaussian  random  variable  which  is 
then  propagated  analytically  through  the  first-order 
linearization  of  the  nonlinear  system  or  nonlinear 
measurement.  Therefore,  it  can  be  viewed  as  providing 
"first-order"  approximations  to  the  optimal  terms.  These 
approximations,  however,  can  introduce  large  errors  in  the 
true  posterior  mean  and  covariance  of  the  nonlinearly 
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transformed  (Gaussian)  random  variable,  which  may  lead 
to  sub-optimal  performance  and  sometimes  divergence  of 
the  filter,  especially  in  strongly  nonlinear  estimation 
problems. 

The  UKF  addresses  some  approximation  issues  of  the 
first-order  EKF.  In  a  UKF,  The  state  distribution  is  again 
represented  by  a  Gaussian  random  variable,  but  is  now 
specified  using  a  minimal  set  of  carefully  chosen  sample 
points.  These  sample  points  completely  capture  the  true 
mean  and  covariance  of  the  Gaussian  random  variable, 
and  when  propagated  through  the  true  non-linear  system, 
capture  the  posterior  mean  and  covariance  accurately  to 
the  3rd  order  (Taylor  series  expansion).  For  details  and  the 
implementation  of  the  UKF,  the  readers  are  referred  to  [3]. 

Another  very  popular  strategy  for  estimating  the  state  of  a 
nonlinear  system  as  a  set  of  observations  becomes 
available  online  is  to  use  sequential  Monte-Carlo  methods, 
also  known  as  the  particle  filter  (PF).  These  methods 
allow  for  a  complete  representation  of  the  posterior 
probability  density  function  (pdf)  of  the  states,  so  that  any 
statistical  estimates,  such  as  the  mean,  mode,  variance  and 
kurtosis  can  be  easily  computed.  They  can,  therefore,  deal 
with  any  nonlinearity  or  probability  distributions  [5].  The 
basic  idea  of  the  particle  filter  begins  with  using  a  set  of 
particles  and  their  associated  weights  to  approximate  the 
state  posterior  pdf.  These  particles  are  propagated  from 
one  time  to  the  next  according  to  the  target  motion  model, 
and  their  weights  are  updated  based  on  the  incoming 
measurements.  It  has  been  shown  in  [5]  that  under  mild 
conditions,  the  approximation  of  the  density  function 
converges  to  the  true  posterior  state  probability  density 
function  almost  surely  as  the  number  of  particles  goes  to 
infinity.  In  this  paper,  we  adopt  a  very  simple  and  popular 
version  of  the  PF,  the  sequential  importance  resampling 
(SIR)  particle  filtering  algorithm  [5]. 


3  Motivating  examples 

3.1  Target  and  measurement  models 

We  assume  that  the  target  motion  is  modeled  as  follows 

X*=FX*-1+V*  (!) 

where  \k  =  [g  g  rjh  rjk]}  is  the  target  state  at  time  k , 
consisting  of  positions  and  velocities  along  £  and  q  axes 
in  a  two-dimensional  Cartesian  coordinate  system.  F  is 
the  state  transition  matrix 


F  = 


1 

0 

0 
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T  0 
1  0 
0  1 
0  0 


0 

0 

T 
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(2) 


in  which  T  is  the  time  interval  between  two  adjacent 
samples,  denotes  the  zero-mean  white  Gaussian  noise 

with  covariance  matrix  Q 


r3/ 3  t2/2  0  0 

T2/2  T  0  0 

0  0  T3/  3  T2/  2 

0  0  T2/2  T 


(3) 


where  q  is  a  scalar.  For  a  radar  that  reports  range-bearing 
measurements,  the  measurement  model  can  be 
mathematically  written  as 

z*  =h(x*)  +  w*  (4) 
where  zk  is  the  radar  measurement, 


h(xt)  = 


>/(&-£  )2 +(%- 7,  )2 

tan -‘[(%-77s)/(4-4)] 


(5) 


is  the  target  position  at  time  k ,  and  (g  tj  )  is  the 
position  of  the  radar,  denotes  the  measurement  noise, 

which  is  Gaussian  with  zero  mean  and  covariance  matrix 
R.  As  we  can  see,  the  motion  model  is  linear  and 
Gaussian.  But  the  measurements  are  nonlinear  functions 
of  the  target  state. 

Note  that  for  the  EKF,  Jacobian  of  measurement  is  given 
by 


A4  o  Aft 

j  =  A&2+A%2  Va42+a%2 

~Afy  0  A4- 

.  a42+a%2  a42+a%2 

where  A<,  =  4_,  -  £  and  A,h  =  -  r,s . 


0 

0 


(6) 


3.2  A  single  radar  with  strong  nonlinearity 

In  this  experiment,  we  assume  that  there  is  a  single  radar 
sensor  that  is  tracking  the  target.  An  example  for  the  target 
trajectory  has  been  shown  in  Fig.  1. 


First,  we  investigate  a  case  with  highly  nonlinear 
measurements.  We  assume  that  the  range  measurements 
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are  very  accurate,  with  a  range  error  standard  deviation 
(s.d.)  of  10  m,  and  the  bearing  measurements  are  relatively 
coarse,  with  a  bearing  error  s.d.  of  3° .  Given  the  geometry 
in  Fig.  1,  it  can  be  shown  that  the  uncertainty  region  of  the 
target  position  based  on  the  range  and  the  bearing 
measurements  is  part  of  a  thin  ring  with  its  span 
proportional  to  the  s.d.  of  the  bearing  measurement. 


Table  L  Note  that  in  the  PF,  2 xlO4 particles  have  been 
used.  As  we  can  see,  the  computational  costs  for  the  PF 
are  much  higher  than  those  of  the  EKF  and  the  UKF. 

Table  I.  Average  number  of  floating  point  operations  per 
iteration  for  different  algorithms 


I 

«=■ 


Fig.  1  Geometry  of  the  target  trajectory  and  the  radar 
sensor. 

In  the  experiment,  the  PF  uses  2 xlO4 particles.  The  root 
mean  square  errors  (RMSEs)  are  obtained  by  taking  an 
average  over  100  Monte-Carlo  simulation  runs.  In  Fig.  2, 
the  RMSEs  of  position  estimates  are  shown.  Since  the 
RMSEs  of  velocity  estimates  exhibit  similar  behaviors  to 
those  of  position  estimates,  they  are  not  shown  to  save 
space.  From  Fig.  2,  it  is  clear  that  the  EKF’s  averaged 
RMSEs  are  much  higher  than  those  of  the  other  two 
algorithms.  This  is  because  in  some  Monte-Carlo  runs,  the 
EKF  diverges.  Since  an  unscented  transform  has  been 
used  in  the  UKF,  the  UKF  provides  significant 
improvement  over  the  EKF.  The  PF  outperforms  the  UKF, 
at  the  cost  of  much  more  computational  complexity. 

3.3  A  single  radar  with  weak  nonlinearity 

Second,  we  investigate  a  case  with  less  nonlinearity  in  the 
measurements.  We  assume  that  the  range  measurement 
error  has  a  s.d.  of  100  m,  and  the  bearing  measurement 
error  has  a  s.d.  of  T .  As  shown  in  Fig.  3,  all  the  three 
algorithms  have  performances  close  to  each  other.  This 
implies  that  for  a  recursive  estimation  problem  with  weak 
nonlinearity,  the  EKF  or  the  UKF  should  be  used  to  save 
the  computational  cost,  while  at  the  same  time  to  achieve 
the  same  performances  as  that  of  the  PF. 
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Fig.  2  RMSEs  in  position  estimates  by  different  tracking 
algorithms.  Triangle:  EKF.  Square:  UKF.  Circle:  PF. 


Fig.  3  RMSEs  in  position  estimates  by  different  tracking 
algorithms.  Triangle:  EKF.  Square:  UKF.  Circle:  PF. 


3.4  Computational  complexities 

To  quantitatively  compare  the  complexities  of  different 
algorithms,  the  average  number  of  floating  point 
operations  per  iteration  for  each  algorithm  is  listed  in 


4  Nonlinearity  measures 

From  the  examples  in  the  last  section,  we  can  see  that 
under  different  circumstances,  it  is  desirable  to  apply 
different  filtering  algorithms.  For  a  tracking  problem  with 
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weak  nonlinearity,  the  EKF  and  the  UKF  are  good 
choices,  since  they  provide  near-optimal  tracking 
performances,  while  at  the  same  time  have  much  less 
computation  complexity  than  the  PF.  However,  in  a  highly 
nonlinear  problem,  the  PF  should  be  used,  since  the  EKF 
and  the  UKF  are  prone  to  divergence  in  such  a  problem. 
As  a  result,  it  is  important  to  develop  a  metric  to  gauge  the 
nonlinearity  of  the  estimation  problem.  For  the  tracking 
problem  with  linear  dynamic  model  and  nonlinear 
measurement  model,  the  nonlinearity  is  brought  by  the 
nonlinear  measurements.  We  propose  the  parameter- 
effects  curvature  and  intrinsic  curvature,  similar  to  those 
used  in  [7],  to  measure  the  nonlinearity  in  the 
measurements.  However,  we  also  observe  that  the 
curvature  measures  can  not  provide  a  direct  and  timely 
indication  of  the  divergence  of  the  EKF  or  the  UKF.  To 
detect  the  divergence  of  a  filter  in  a  timely  manner,  we 
also  develop  a  Chi-square  detector  based  on  the 
innovation  of  the  Kalman  filter,  which  checks  the 
consistency  of  the  filter,  and  detects  the  filter  divergence 
when  it  occurs. 

4.1  Curvature  nonlinearity  measures 

We  try  to  measure  the  nonlinearity  in  the  measurements 
using  curvature  measures  [6],  as  proposed  in  [7].  In  [7], 
the  measures  have  been  used  in  trajectory  estimation 
problems.  Here  we  apply  them  for  measuring  and 
detecting  the  nonlinearity  in  target  tracking  problems. 

The  nonlinear  measurement  model  (4)  can  be  rewritten  as 

zk  =h(Pj-)  +  w/t  (7) 


where  =  [<£  rjk]'  is  the  target’s  coordinates  at  time  k , 
since  zk  is  not  a  function  of  the  target’s  velocity  at  time 

k  .In  a  EKF,  the  nonlinear  measurement  is  approximated 
by  the  first  order  Taylor  series  expansion  of  h(p^)  about 

the  predicted  target  position  p  : 


h(pt )  ~  l*(P*|*-i )  +  H,  (Ptn-.,  )(P*  -  )  (8) 

where 


®*(P*i*-i) 


dh(pj 


dPk 


H,(p  »_,)€*" 


(9) 


P*~P/fc|*-l 


where  nz  and  ^are  the  dimensions  of  the  measurement 

and  the  target  position,  respectively.  The  first-order  EKF 
uses  the  linear  approximation  by  ignoring  the  higher  order 
terms  in  the  Taylor  series  expansion.  The  linear 
approximation  in  the  EKF  is  valid  only  if  the  measurement 
function  is  relatively  flat  near  p^ ^and  the  hence  the 

tangent  plane  approximation  in  (8)  is  valid.  Taking  the 


Taylor  series  expansion  of  (7)  up  to  the  second  order,  we 
have 


h(P  J  ~  h(P*M )  +  (Pm-i  )(P*  -  Ptit-i ) 

+  ^(P/t  P*i*-i )  ®-*(P*i*-i)(P;t  P*i*-i ) 

where 


(10) 


hm«  (P»_i )  — 


32hm(P) 


Sp,3p, 


H(p»_i)  £  R 


(11) 


P-Pfc|/fc-l 


m  =  l,-*-,/2z,  i,j  — 

According  to  the  linear  approximation  (8),  h(p^)lies  in 

the  plane  tangent  to  the  measurement  surface  at  the  point 
p  .  Therefore,  the  linearization  in  the  measurement 

model  is  equivalent  to  approximating  the  measurement 
surface  by  the  tangent  plane  at  p^ .  The  tangent  plane  is 

a  good  approximation  to  the  measurement  surface  if  the 
norm  of  the  quadratic  term 

||(Pt  "Pt|t-i),Hi(ptM)(pi  -P*1W)||  I®  negligible  compared 

with  the  norm  of  the  linear  term  ||h,(p*m)(P* -p*|W)||  • 

It  is  useful  to  decompose  the  quadratic  term  on  the  right 
hand  side  of  (10)  into  components  in  the  tangent  plane  and 
orthogonal  to  the  tangent  plane. 


In  order  to  define  the  curvature  measures  of  nonlinearity, 
velocity  vectors  and  acceleration  vectors  [6]  are 
introduced,  which  form  the  Jacobian  and  Hessian, 
respectively.  The  n  x  1  velocity  vectors  are  defined  by 


^ki  (P k\k-\ )  — 


3h,(pJ 

5h„;(Pt) 

dP  ti 

P*=Ptpt-? 

Pa  — P>t|A  i 

i  =  \,2,---np 

and 


(12) 


(P*|*-l )  “  (P k\k-\ )  *  *  *  ^knp  (P &|&-1 )  J 

The  n_  x  1  symmetric  acceleration  vectors  are  defined  by 


h(p  )  =  fMPk) 


5p,5p. 


,  h,(p,M)e/?" 


IP=P*|*-1 


Uj  - 1 


(14) 


The  acceleration  vectors  are  decomposed  into  components 
in  the  tangent  plane  and  orthogonal  to  the  tangent  plane. 
Let  H  (Dm,  , )  g  R'lpXrip  denote  the  mth  face  of  the 

acceleration  array 
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(15) 


(NIS)  [2]  of  the  EKF  or  UKF  and  compare  it  with  a 
threshold.  The  NIS  is  defined  as 


hmll(P*|it-l) 
Kn  l(P^-l) 


^m\np^k\k-\) 
^mnpnp  (P k\k-\  ) 


m  = 

The  projection  matrix  Pr  which  projects  an  nz  x  1  vector 
into  the  tangent  plane  is  defined  by 

Pr  =  H*(P*|*-,)[Hk  '(Pt|*_i )H«r (P**-! )]  1  H,  '(p*M)  (16) 


Therefore,  we  can  decompose  an  acceleration  vector  into 
components  tangent  and  orthogonal  to  the  tangent  plane. 
Let  hJ(ptM)and  h^p^)  denote  the  tangential  and 

orthogonal  components  of  the  acceleration  vector 
htf(p*M)  ,  respectively.  Then 


h  (/  (  P  a- |/c  - 1  )  —  ^T^hj  (p  k\k-\  ) 

h,yP^i)  =  (I-Pr)h,(p,M) 

N-(P^-i)  =  (PiM  )  +  (PiU-i) 


NIS  =  [z,  -  h(xtjW)]'S;‘[zt  - h( V,)]  (22) 

where  zt  -h(xit|Jt_1)is  the  innovation  of  the  EKF  or  the 
UKF,  and 

s*  =  J*VA'+R  (23) 

is  the  covariance  matrix  of  the  innovation,  which  is 
provided  by  the  filter.  When  the  linear  and  Gaussian 
assumption  is  reasonably  good,  the  innovation  is  a  zero- 
mean  Gaussian  and  its  covariance  is  given  by  .  In  such 

a  case,  the  NIS  follows  a  Chi-square  distribution  with 
n_  degrees  of  freedom.  However,  when  the  filter  diverges, 

the  NIS  will  no  longer  follow  a  Chi-square  distribution. 
Hence,  we  propose  to  check  if  the  NIS  falls  into  the  1  -  a 
confidence  region  for  a  Chi-square  random  variable  with 
n_  degrees  of  freedom,  to  judge  if  the  filter  diverges.  Here 

a  is  a  very  small  number,  which  is  actually  determined  by 
the  false  alarm  rate  of  the  Chi-square  detector. 


for  i9j  =  1?. .  -9np  •  Use  of  (17)  for  the  quadratic  term  in 
(10)  gives 

\&k  H(p^_i)^|  —  | Sk  H  (p^_i)^|  +|| Sk  H  (p^-i)^! 

(18) 

where 

<?*=P*-P*M  (19) 

Bates  and  Watts  [6]  define  the  parameter-effects  curvature 
Kl  and  intrinsic  curvature  K*  as  two  measures  of 

o  o 

nonlinearity,  which  compare  the  quadratic  term  with  the 
linear  term  in  the  direction  of  the  vector  Sk  in  the 

parameter  space.  These  two  curvature  measures  are 
defined  as 


4.3  Experimental  results 

4.3.1  A  single  radar  with  strong  nonlinearity 

In  this  experiment,  we  assume  that  there  is  a  single  radar 
sensor  that  is  tracking  the  target.  The  geometry  of  the 
radar  and  the  trajectory  is  similar  to  that  shown  in  Fig.  1. 
First,  we  investigate  a  case  with  highly  nonlinear 
measurements.  We  assume  that  the  range  measurements 
are  very  accurate,  with  a  range  error  standard  deviation 
(s.d.)  of  10  m,  and  the  bearing  measurements  are  relatively 
coarse,  with  a  bearing  error  s.d.  of  4° . 

For  a  single  Monte-Carlo  run,  the  target  state  estimation 
errors  are  plotted  in  Fig.  4  for  different  algorithms.  It  can 
be  seen  that  the  EKF  diverges,  while  the  PF  and  the  UKF 
converges  and  have  very  similar  performances. 


Kl 

KNS 


(20) 

||H(p*M)<?t||2 

K'H^p,MH|| 

(21) 

1"1(P k\k-\ 


In  Fig.  5,  the  parameter-effects  curvature  defined  in  (20) 
have  been  plotted  for  the  EKF  and  the  UKF.  It  is  clear  that 
the  maximum  curvature  measure  for  the  EKF  (around 
100)  is  much  greater  than  that  of  the  UKF  (below  1), 
indicating  that  the  EKF  is  not  working  properly.  However, 
the  curvature  measures  can  not  indicate  the  divergence  of 
the  EKF  in  real  time,  since  its  peak  value  occurs  a  long 
time  after  the  EKF  diverges. 


4.2  Chi-square  detector  based  on 
innovation 

To  check  if  the  EKF  or  UKF  diverges,  a  very  effective 
way  is  to  calculate  the  normalized  innovation  squared 
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Fig.  4  RMSEs  in  position  by  different  tracking  algorithms. 


In  Fig.  8,  the  curvature  measures  for  the  EKF  and  the 
UKF  are  plotted.  It  is  clear  that  due  to  the  low 
nonlinearity,  the  curvature  measures  are  very  small. 

Similarly,  the  NISs  for  the  EKF  and  the  UKF  are  within 
the  98%  confidence  region  for  all  the  time,  as  illustrated  in 
Fig.  9. 


4.3.3  Two  bearing  sensors 

In  this  experiment,  we  assume  that  two  bearing-only 
sensors  are  used  to  provide  positional  information  to  the 
tracker.  The  target  trajectory  and  the  positions  of  the  two 
sensors  are  shown  in  Fig.  10.  Each  sensor  has  a 
measurement  error  s.d.  of  3° . 


In  Fig.  6,  the  NISs  are  shown  for  the  EKF  and  the  UKF.  It 
is  evident  that  for  most  of  the  time,  the  NIS  of  the  EKF  is 
outside  the  one-sided  98%  confidence  region  of  the  Chi- 
square  distribution  with  two  degrees  of  freedom,  correctly 
indicating  the  EKF  is  diverging.  On  the  contrary,  the  NIS 
for  the  UKF  is  inside  the  98%  confidence  region  at  all  of 
the  time.  It  is  clear  that  the  Chi-square  detector  based  on 
the  innovation  of  the  Kalman  filter  is  effective  in  detecting 
the  filter  divergence  in  real  time. 


Fig.  5  Curvature  measures  for  the  EKF  and  the  UKF. 


4.3.2  A  single  radar  with  weak  nonlinearity 

We  investigate  a  case  with  very  weak  nonlinearity  in  the 
measurements.  We  assume  that  the  range  measurement 
error  has  a  s.d.  of  100  m,  and  the  bearing  measurement  has 
a  s.d.  of  1° .  As  we  can  see  from  Fig.  7,  both  the  EKF  and 
the  UKF  work  well  and  have  performances  which  are  very 
close  to  that  of  the  PF. 
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Fig.  6  NISs  for  the  EKF  and  the  UKF.  Dashed  line 
denotes  the  one-sided  98%  confidence  region. 


algorithms. 
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Fig.  9  NISs  for  the  EKF  and  the  UKF.  The  dashed  line 
denotes  the  one-sided  98%  confidence  region. 


$  (km) 


Fig.  10  Geometry  of  the  target  trajectory  and  the  bearing 
sensors. 

The  tracking  performances,  the  curvature  measures  and 
the  NISs  are  plotted  in  Figs.  11-13,  respectively.  It  can  be 
seen  that  the  UKF  diverges  in  the  first  50  seconds,  during 
which  time,  its  NIS  falls  outside  the  98%  confidence 


region.  The  peak  values  of  its  curvature  measures  are 
much  greater  than  those  of  the  EKF. 

In  summary,  both  the  curvature  measure  and  the  NIS  are 
effective  measures  of  the  nonlinearity  of  the  nonlinear 
tracking  problems.  One  problem  with  the  curvature 
measure  is  that  its  evaluation  requires  the  true  value  of  the 
target  position  \gk  rjk]' ,  which  is  not  available  on-line. 

One  possible  solution  is  to  use  the  updated  position 
estimate  [|  4J',  which  is  generated  by  the  filter,  to 

replace  [gk  rjk]' •  This  estimated  value,  however,  is  not 

robust,  especially  when  the  filter  itself  is  diverging.  On  the 
other  hand,  one  can  certainly  use  the  curvature  measures 
offline  via  simulations,  to  evaluate  the  nonlinearity  of  a 
specific  tracking  problem,  with  all  the  pre-specified 
parameters. 

The  NIS,  however,  does  not  require  the  knowledge  of  the 
true  [£  rjk  ]  * ,  since  the  innovation  is  simply  the  difference 

between  the  predicted  measurement  provided  by  the  filter, 
and  the  incoming  measurement.  As  we  have  observed  in 
the  experiments,  the  NIS  is  very  effective  in  indicating  the 
divergence  of  the  filter,  when  there  is  significant  mismatch 
between  its  estimation  error  and  its  calculated  covariance 
matrix. 


Fig.  11  Tracking  performances  of  different  tracking 
algorithms. 


5  Conclusion 

In  this  paper,  we  investigated  different  nonlinear  filtering 
techniques,  including  the  EKF,  the  UKF,  and  the  PF  for 
nonlinear  target  tracking  problems  under  various 
scenarios.  Their  tracking  performances  were  compared 
and  their  complexities  were  evaluated  in  terms  of  the 
numbers  of  floating  point  operations.  It  was  shown  that  for 
a  tracking  problem  with  weak  nonlinearity,  the  EKF  and 
the  UKF  are  near-optimal  and  it  is  not  necessary  to 
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employ  the  computationally  expensive  particle  filter. 
However,  for  problems  with  strong  nonlinearity,  particle 
filters  should  be  used  to  get  reliable  tracking 
performances. 


Fig.  12  Curvature  measures  for  the  EKF  and  the  UKF 
over  time. 
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